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Abstract 

The paper proposes a technique to estimate the angular velocity of a rigid body from vector measurements. Compared to 
the approaches presented in the literature, it does not use attitude information nor rate gyros as inputs. Instead, vector 
measurements are directly filtered through a nonlinear observer estimating the angular velocity. Convergence is established 
using a detailed analysis of the linear-time varying dynamics appearing in the estimation error equation. This equation stems 
from the classic Euler equations and measurement equations. A high gain design allows to establish local uniform exponential 
convergence. Simulation results are provided to illustrate the method. 
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1 Introduction 

This article considers the question of estimating the an¬ 
gular velocity of a rigid body from embedded sensors. 
This general question is of particular importance in var¬ 
ious fields, and in particular for the problem of orienta¬ 
tion control. As is well described in [1], most existing con¬ 
trol methods for such second order dynamics require an¬ 
gular velocity information [2-4]. The list of typical con¬ 
trol methods employing this information is vast, ranging 
from Lyapunov control design, feedback linearization, 
to the computed torque method. Numerous implemen¬ 
tations can be found in spacecraft, low-cost unmanned 
aerial vehicles, guided ammunitions, to name a few. 

In the literature, several types of methods have been 
proposed to address this question. On the one hand, 
the straightforward solution is to use a strap-down rate 
gyro [5], which directly provides measurements of the 
angular velocities. However, rate gyros being relatively 
fragile and expensive components, prone to drift, an¬ 
other type of solutions is often preferred. Instead, a two- 
step approach is commonly employed. The first step is 
to determine attitude from vector measurements, i.e. 
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onboard vector measurements of reference vectors be¬ 
ing known in a fixed frame. Vector measurements play 
a central role in the problem of attitude determination 
as discussed in a recent survey [6]. In a nutshell, when 
two independent vectors are measured with vector sen¬ 
sors attached to a rigid body, its attitude can be simply 
defined as the solution of the classic Wahba problem [7] 
which formulates a minimization problem having the ro¬ 
tation matrix from a fixed frame to the body frame as 
unknown. The second step is to reconstruct angular ve¬ 
locities from the attitude. At any instant, full attitude 
information can be obtained [8-11]. In principles, once 
the attitude is known, angular velocity can be estimated 
from a time-differentiation. However, noises disturb this 
process. To address this issue, introducing a priori infor¬ 
mation in the estimation process is a valuable technique 
to filter-out noise from the estimates. For this reason, 
numerous observers using the Euler equations for a rigid 
body have been proposed to estimate angular velocity 
(or angular momentum, which is equivalent) from full 
attitude information [1,12-14]. Besides this two-step ap¬ 
proach, a more direct solution can be proposed. In this 
paper, we expose an algorithm that directly uses the vec¬ 
tor measurements and reconstructs the angular velocity 
in a simple manner. 


The contribution of this paper is a nonlinear observer re¬ 
constructing the angular velocity of a rotating rigid body 
from vector measurements directly, namely by bypassing 
the relatively heavy first step of attitude estimation. 
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The paper is organized as follows. In Section 2, we in¬ 
troduce the notations and the problem statement. We 
analyze the attitude dynamics (rotation and Euler equa¬ 
tions) and relate it to the measurements. In Section 3, we 
define a nonlinear observer with extended state and out¬ 
put injection. To prove its convergence, the error equa¬ 
tion is identified as a linear time-varying (LTV) system 
perturbed by a linear-quadratic term. The dominant 
part of the LTV dynamics can be shown, by a scaling 
resulting from a high gain design, to generate an arbi¬ 
trarily fast exponentially convergent dynamics. In turn, 
this property reveals instrumental to conclude on the ex¬ 
ponential uniform convergence of the error dynamics. Il¬ 
lustrative simulation results are given in Section 4. Con¬ 
clusions and perspectives are given in Section 5. 

2 Notations and problem statement 

2.1 Notations 

Vectors in are written with small letters x. 
|x| is the Euclidean norm of x. [xx] is the skew- 
symmetric cross-product matrix associated with x, i.e. 
Vy G [xx]y = X X y. Namely, 

/ 0 -X 3 X 2 \ 

[xx] = a;3 0 -xi 

y -X2 xi 0 J 

where xi,X 2 , X 3 are the coordinates of x in the standard 
basis of 

Vectors in K® are written with capital letters X. \X\ is 
the Euclidean norm of X. The induced norm on 9 x 9 
matrices is noted || • ||. Namely, 

||M|| = max IMVl 

|JC| = 1 

Eor convenience, we may write X under the form 

x = (x^,x^,xi:f 

with Xi, X 2 , X 3 G Note that 

|V|2 = |Vi|2 + |V2|2 + |V3p 

Frames considered in the following are orthonormal 
bases of . 

2.2 Problem statement 

Consider a rigid body rotating with respect to an iner¬ 
tial frame TZi. Note R the rotation matrix from TZi to 


a body frame TZb attached to the rigid body and w the 
corresponding angular velocity vector, expressed in TZb- 
Assuming that the body rotates under the influence of 
an external torque r (which, is null in the case of free- 
rotation), the variables R and oj are governed by the 
following differential equations 

R=R[cOy,] ( 1 ) 

LO = J~^ ( Jw X w -I- t) = E{uj) + J~^T (2) 

where J = diag( Ji, J 2 , J 3 ) is the inertia matrix ^. Equa¬ 
tion (2) is known as the set of Euler equations for a 
rotating rigid body [15]. The torque r may result from 
control inputs or disturbances ^ . 

We assume that two reference unit vectors a, b expressed 
in TZi E^re known, and that sensors arranged on the rigid 
body allow to measure the corresponding unit vectors 
expressed in TZb- Namely, the measurements are 

a{t) = R{tfa, bit) = R{t)'^b (3) 

Eor implementation, the sensors could be e.g. accelerom¬ 
eters, magnetometers, or Sun sensors to name a few [16]. 
We now formulate some assumptions. 

Assumption 1 d, 6 are constant and linearly indepen¬ 
dent 

Assumption 2 J and t are known 

Assumption 3 to is bounded: |w(t)| < Wmax at all times 

Assumption 1 implies that 

p = a 0 = a b 

is constant for all times. Without loss of generality, we 
assume a^b > 0 (if not, one can simply consider —a 
instead of a). The problem we address in this paper is 
the following. 

Problem 1 Under Assumptions 1-2-3, find an estimate 
to of uj from the measurements a, b defined in (3). 


^ Without restriction, we consider that the axes of TZb are 
aligned with the principal axes of inertia of the rigid body. 

^ In the case of a satellite e.g., the torque could be generated 
by inertia wheels, magnetorquers, gravity gradient, among 
other possibilities. 
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3.2 Preliminary change of variables and properties 


3 Observer definition and analysis of conver¬ 
gence 

3.1 Observer definition 


The time derivative of the measurement a is 

a = ii’"a = —[uJx]R^d = a x to (4) 

and the same holds for 6 = 6 x w. To solve Problem 1, the 
main idea of the paper is to consider the reconstruction 
of the extended 9-dimensional state X by its estimate X 


V = 

(a] 

b 

, x = 

b 


yiv) 


yo) 


The state is governed by 

( 


X = 


ax oj 
b X tv 


y E{u}) + J J 


and the following observer is proposed 


( 5 ) 


/ a X u! — ak{d — a) \ 

X = b X lit — akib — b) 

y E{1j) + J~^T + k^a X (a — a) + k^b x ib — b) j 

( 6 ) 

where a € (0, 2-y/l — p) and fc > 0 are constant (tuning) 
parameters. Note 


The study of the dynamics (8) employs a preliminary 
change of coordinates. Note 


Z = 


il] 


VI/ 


(9) 


yielding 


with 


Z = kA{t)Z + 


! 0 \ 


E{uj)-E{<:b) 
K k 


m = 


/ -al 0 [a(t)x]\ 

0 -al [b{t)x] 

y[a(t)x] [6(t)x] 0 j 


( 10 ) 


( 11 ) 


which we will analyze as an ideal linear time-varying 
(LTV) system 

Z = kA{t)Z (12) 

perturbed by the input term 




( 0 \ 


E{uj) — E{lj) 

V k , 


(13) 


The idea is that for sufficiently large values of fc, the 
rate of convergence of (12) will ensure stability of system 
(10). We start by upper-bounding A{t) and the distur¬ 
bance (13). 


14 V- 


( 

b 

\o) 


( 7 ) 


Proposition 1 (Bound on the unforced LTV system) 

A{t) defined in (11) is upper-bounded by 


Am = max 


(V2-f 2a^ V3-ba2^ 


the error state. We have 



^ —aki 0 [ox] ^ 


( ^ 

X = 

0 —akI [6x] 

x + 

0 


yfc2[ax] k'^[bx] 0 ) 


y E{oj) — E{1>) J 


( 8 ) 


In Section 3.4 we will exhibit, for each value a G (0, 2^Jl — p), 
a threshold value k* such that for A: > fc*, V converges 
locally uniformly exponentially to zero. 


PROOF. Let V G such that |V| = 1. One has 

\A{t)Y\^ =1 - oYi -f a X Tap + \-aY2 + bx Tap 
+ \axYi+bxY2\‘^ 

<(1 + a^) (|y,|2 + |a X Tap + |l" 2 p + 1^ x VaP) 
2 (|a X Yi|^ -|- \b X 
< max (2 -I- 2 q;^, 3 -I- a^) |Vp = 

Hence, ||H|| < Am. 
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Proposition 2 (Bound on the disturbance) For 

any Z, ^ is bounded by 

|?|<V^Wmax|^|+A:|Z|2 (14) 


PROOF. We have 

\^\ = l\E{u:)-Em 

with, due to the quadratic nature of E{-), 

E{uj) — E{Cj) = J~^ {JCj X w + Jw X w — Jw X w) 


/ pjfp {UJ2UJ3 + UJ2UJ3) ^ 



{UJ3UJI + UJ3UJI) 

- 


y -pjp (UJ1C02 + W1W2) J 




^ <5i - <52 


• M(-) is Lipschitz 

• there exists K > 1, c > 0 such that for any t and any 
s > 0, 

Then, for any the solution oi Z = M{t)Z with 

initial condition Z(to) = Zq satisfies, for any t > to, 

Using this result, we will show that the convergence 
of (12) can be tailored by choosing k to arbitrarily in¬ 
crease the rate of convergence, while keeping the over¬ 
shoot constant. 

Theorem 1 Let a € (0,2-^1 — p) be fixed. There exists 
a continuous function j{k) satisfying 

lim 7 (A:) = -|-oo 

k—¥-\-(X) 

such that the solution of (12) satisfies 


As Ji, J 2 , J 3 are the main moments of inertia of the rigid 
body, we have [15] (§32,9) 


|Z(t)| < 


Ji ^ Jj Jf^ 


for all permutations z, j, k and hence 


J 2 — J 3 


J 3 -J 1 


J 1 -J 2 

Ji 

5 

J 2 

•) 

J 3 


As a straightforward consequence 


with 



1+ V- 

Ol 

A 


/i-p 

\ 

1 — 

Oi 

\ 

2^ 

/1-p 


(15) 


for any initial condition to, Z{to) and any t > to- 


PROOF. Consider any fixed value of t. We start by 
studying the frozen-time matrix Aft). Note 


[<521 < |<bp 


V8(l 


Moreover, by Cauchy-Schwarz inequality 

(W2W3 -|- (I’2^<-^3)^ ^ (<X>2 + ^3)(^2 d” ^3) — (*^2 d” ^3)I'^P 

Using similar inequalities for all the coordinates of i5i 
yields 

|<5iP<2|a;n<bp<2o.Lxl^P 

Hence, 


ICI< 


l^l| + l^2| 


< V2u 


< V^Wmaxl-Z^I d- 


3.3 Analysis of the LTV dynamics Z = kA(t)Z 

We will now use a result on the exponential stability of 
LTV systems. The claim of [17] Theorem 2.1, which is 
instrumental in the proof of the next result, is as follows: 
consider a LTV system Z = M{t)Z such that 


Introduce the following (time-varying) matrices 


Pi 


P 2 


P 3 


Pa 


/ a 0 
0 b 
\0 0 


b—pa \ 

V2(l-P") 

a—pb 

vJ-pA 

0 / 


/ 2 {pa — b) 0 \ 

2 {a — pb) 0 

y a a X b —Vs — a xb j 

i 2a X b 0 

2a X b 0 

ya{b—a) ^4(1 + p) — a‘^{a — 


\ 

b)) 


1 

T 


( 2 a xb 0 \ 

—2a xb 0 

yQ;(a-|-5) -^4(1 - p) - a‘^{a -f b) J 
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and 

We have 


with 


P = {Pl\P2\P3\P4) G 


09x9 


p-^A{t)P = 


f Ml 0 0 0 \ 

0 Ma 0 0 

0 0 M3 0 

\ 0 0 0 M 4 y 


with 


Ml = -al, M, = - 


1 / —a —\Ja.i — 


2 y Vofi — —a 


for i = 2,3,4 with 

a 2 = 2 V 2 > as = 2 a/1 + p > 0:4 = 2a/1 — p > a 
For all s > 0 


.Ait)s\\ < iipii IIP 


-111 


Moreover 


IPII IIP-^I = 


IXm..{P^P) 

XminiP^P) 


where Amax, Amin respectively designate the maximum 
and minimum eigenvalues. Besides, 


pTp = 


with, for z = 2,3,4 

Q^ = 

yielding the eigenvalues 
eig(P^P) = |l,l±;^,l± 


0 

0 

0 ^ 

0 Q 2 

0 

0 

0 0 

Qi 

0 

0 

0 

0 

Q 4 J 


a 

\ 

w 

1- ^ 
OLi 

1 

a" 

— 1 -\- 

a 

_ _, X 

A 

2-[/l + p 


1± 


a 


Thus, for all s > 0 




K = 


'Amax(P^P) 


, Ami„(P^P) 

Let fc > 0 be fixed. The scaled matrix kA{-) satisfies 


1 + 




^kA{t)s 


< Ke 2 ^ Vf, Vs > 0 


Moreover, for any T e ffi® and any t,s G M, one has 
{kA{s) - kA{t))Y = k f A{u)du Y 


( 


= k 


\ 


a(u) X uj{u)du Ya 
/y b{u) X uj(u)du Ya 
y /y a{u) X uj{u)du Yi + b(u) x uj(u)du Y 2 J 


Hence 

\ikAis)-kA{t))Yf<2u;l,^k^\s-tf\Yf 

Thus, kA{-) is fcP—Lipschitz with 

L 4 V^tCmax (16) 

We now apply [17], Theorem 2.1. For any tg and any Zq, 
the solution of (12) with initial condition Z{tQ) = Zq 
satisfies for all t > to 


(17) 


\Z{t)\ < 

which concludes the proof with 

7(^) “ - ^KkLhiK 

Remark 1 Additionally, one can note that 

• ^{k) >0 <J4> k> in whieh case Theo¬ 

rem 1 ensures exponential stability of system (12). 

• 7 (-) is strictly increasing for k > ■ 

3.4 Convergence of the observer 
Define r as 


r(k) = 


1 


1 - 


K^V2u 


[ l{k) 

and k* as 

+ Vln K + 2aK^ ^ 


7 (fc)y 


(18) 


k* = 


The following holds 


V^iVwmax > 0 (19) 
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Proposition 3 r{k) > 0 if and only if k > k* 


Hence, the derivative of V along the trajectories of (10) 
is 


PROOF. A simple rewriting of r{k) > 0 yields, succes¬ 
sively, 


|v(t,z) = -|z|^ + A((,z)« 


r(fc) >0 4^ 7 (fc) > = K‘^L 

77 —k — V LK hiK'/k — K^L > 0 

^ ^/LK \tlK + y/LK \nK + 2aLK^ _ ^ 

a 

which concludes the proof. 


We can now state the main result of the paper. 

Theorem 2 (main result) For any a G (0,2-^1 — p), 
there exists k* defined by (19)-(15) such that for k > k*, 
the observer (6) defines an error dynamics (8) for which 
the equilibrium 0 is locally uniformly exponentially stable. 
The basin of attraction of this equilibrium contains the 
ellipsoid 


|a( 0), |d(0)p + |&(0)p + ^^<r(A:)2| (20) 


where r{k) is defined by (18). 


PROOF. Let k > k*. Consider the candidate Lya¬ 
punov function 


Vit,Z) 4 



(j>{T, ty (j){T,t)di 


Z 


Using 




= 2 


r+oo 


(j){T, t)'^(j){T, t)dTZ 


<-^\Z\ 


l{k) 


together with inequality (14) yields 


dV 




< 


l{k) 




Hence 


= -IU3(Z) 
As k > k*, we have 


IZI 


K V^a^max p. 

lik) 

We proceed as in [18] Theorem 4.9. If the initial condition 
of (10) satisfies 


\Zm<r{k) 


77|Z(0)| < 


l{k) 

kK^ 


KW2uj^^\ 
l{k) j 



where 4> is the transition matrix of system (12). Let (t, Z) 
be fixed. From Proposition 1, kA{-) is bounded by kAm- 
Thus (see for example [18] Theorem 4.12) 

V{t,Z)>,^\Z\^^c,\Z\^^W,{Z) 


then W3{Z{0)) > 0 and, while W 3 (Z{t)) > 0, Z{-) re¬ 
mains bounded by 


\Z{t)f< 


V{t) ^ U(0) ^ C2 


< 


Cl 


< -1^(0)!^ 
Cl Cl 


Moreover, Theorem 1 implies that for all r > t 
\(l){T,t)Z\ < 

which gives 

r+oo t^2 

V{t,Z) < / e-27(CU-t)(;^|^|2 ^ —— [ZJ^ 

Jt 27 (A)) 

^CalZj^A W2(Z) 

By construction, V satisfies 
r)V B 

-^{t,Z) + —V{t,Z)kA{t)Z = -\Zf 


which shows that 

From [18], Theorem 4.10, (10) is locally uniformly expo¬ 
nentially stable. From (9), one directly deduces that the 
basin of attraction contains the ellipsoid (20). 

Remark 2 The limitations imposed on a(0) and 6(0) 
in (20) are not truly restrictive, as the actual values 
a(0),6(0) are assumed known, so the observer may be 
initialized with d(0) = 0, 5(0) = 0. What matters is that 
the error on the unknown quantity a;(0) can be large in 
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practice. Interestingly, when k goes to infinity r(k) tends 
to the limit 

1 IQ:\^ 

and arbitrarily large w(0) is thus allowed from (20). 

Remark 3 The threshold k* depends linearly on ujmax, 
which gives helpful hint in the tuning of observer (6). 


4 Simulation results 

In this section we illustrate the dependence of the ob¬ 
server with respect to three parameters 

• p which quantifies the linear independence of (a, b) 

• Wniax the maximal rotation rate of the rigid body 

• the tuning gain k 

Simulations were run for a model of a CubeSat [19]. The 
rotating rigid body under consideration is a rectangu¬ 
lar parallelepiped of dimensions 20 cm x 10 cm x 10 cm 
and mass 2kg assumed to be homogeneously distributed. 
No torque is applied on this system, which is thus in 
free-rotation. 

In this simulation the two reference unit vectors are the 
Sun direction a and normalized magnetic field b. The 
satellite is equipped with 

• 6 Sun sensors providing at all times a measure of the 
Sun direction ya in a Sun sensor frame TZs 

• 3 magnetometers able to measure the normalized mag¬ 
netic field yb in a magnetometer frame TZm 



Fig. 1. Normalized sensor outputs during rotation motion: 
Sun (top, three coordinates) and magnetic field (bottom, 
three coordinates) 


Typical sensor outputs are given in Figure 1. Because the 
initial angular velocity vector is not aligned with any of 
the principal axes of inertia, the rotation motion is not 
periodic. As can be observed, significant levels of noise 
have been added on each channel. 

It shall be noted that, in practical applications, the sen¬ 
sor frames TZg need not coincide TZm and can also dif¬ 
fer from the body frame TZb (defined along the princi¬ 
pal axes of inertia) through a constant rotation Rm.bi 
respectively Rs,b- With these notations, we have 

a = Rli^bVa, b = R^^byb 


Figure 2 shows the convergence of the observer with 
parameter values corresponding to the measurements 
shown in Figure 1. Note that the vector measurement 
noise is smoothly filtered by the observer, thanks to the 
relatively low value of the gain k. Figure 3 shows the 
influence of p. When p gets close to 1, the rate of con¬ 
vergence is decreased. This was to be expected. To the 
limit, when p = 1, all the matrices A{t) become sin¬ 
gular and the proof of convergence can not be applied 
anymore. In Figure 4 we report the behavior of the ob¬ 
server for increasing values of comax- The faster the ro¬ 
tation, the slower the convergence. A faster convergence 
can be achieved by increasing the gain k. This increases 
the sensitivity to noise, as represented in Figure 5. 


which is a simple change of coordinates of the measure- 

nients. ^ Conclusions and perspectives 


For sake of accuracy in the implementation, reference 
dynamics (5) and state observer (6) were simulated us¬ 
ing Runge-Kutta 4 method with sample period 0.1s for 
various values of p and a;(0) and with a = y/1 — p. 


A new method to estimate the angular velocity of a rigid 
body has been proposed in this article. The method uses 
onboard measurements of constant and independent vec¬ 
tors. The estimation algorithm is a nonlinear observer 


7 










k =0.25, Wmax =0.11 [rad/s], p =0.2 



Fig. 2. Convergence of the observer 



Fig. 3. The rate of convergence degrades when p increases. 

which is very simple to implement and induces a very 
limited computational burden. At this stage, an inter¬ 
esting (but still preliminary) conclusion is that, in the 
cases considered here, rate gyros could be replaced with 
an estimation software employing cheap, rugged and re¬ 
silient sensors. In fact, any set of sensors producing vec¬ 
tor measurements such as e.g.. Sun sensors, magnetome¬ 
ters, could constitute one such alternative. Assessing the 
feasibility of this approach requires further investiga¬ 
tions including experiments. 

More generally, this observer should be considered as a 
first element of a class of estimation methods which can 
be developed to address several cases of practical inter¬ 
est. In particular, the introduction of noise in the mea¬ 
surement and uncertainty on the input torque (assumed 
here to be known) will require extensions such as opti¬ 



Fig. 4. Impact of c^max on the convergence rate 



Fig. 5. When k increases, the convergence is faster but the 
measurement noise filtering degrades. 

mal filtering to treat more general cases. White or col¬ 
ored noises will be good candidates to model these ele¬ 
ments. Also, slow variations of the reference vectors d, b 
should deserve particular care, because such drifts natu¬ 
rally appear in some cases. For example, the Earth mag¬ 
netic field measured onboard satellites varies according 
to the position along the orbit. 

On the other hand, one can also consider that this 
method can be useful for other estimation tasks. Among 
the possibilities are the estimation of the inertia J ma¬ 
trix which we believe is possible from the measurements 
considered here. This could be of interest for the recently 
considered task of space debris removal [20]. Finally, 
recent attitude estimation techniques have favored the 
use of vector measurements together with rate gyros 
measurements as inputs. Among these approaches, one 
















































































































































































can find i) Extended Kalman Filters (EKF)-like algo¬ 
rithms e.g. [21,22], a) nonlinear observers [23-28]. This 
contribution suggests that, here also, the rate gyros 
could be replaced with more in-depth analysis of the 
vector measurements. 
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